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摘 要 : 与 基于 视觉 的 同时 定位 与 地 图 构建 《SLAM) 技术 相 比 ， 激 光 SLAM 由 于 定位 的 稳健 性 成 为 国内 外 研究 热 
点 。 目 的 是 在 未 知 环境 中 定位 自身 位 姿 并 同时 构建 环境 地 图 ， 广 泛 应 用 在 无 人 驾驶 、 室 内 外 机 器 人 导航 以 及 三 维 重 
建 等 领域 。 文 中 首先 分 解 激 光 SLAM 的 基本 框架 ， 分 别 对 前 端 扫 描 匹 配 、 后 端 优化 、 闭 环 检 测 与 验证 、 地 图 构建 四 
个 模块 近年 来 的 主流 算法 进行 总 结 ; 然后 对 基于 滤波 器 和 基于 图 优化 两 种 激光 SLAM 框架 下 的 代表 性 方案 进行 深入 
分 析 和 比较 ; 最 后 对 激光 SLAM 的 发 展 趋势 进行 展望 。 
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Abstract: Compared with visual based simultaneous localization and mapping (SLAM) technique, due to the robustness of 
localization, laser based SLAM become a research hotspot at home and abroad. The purpose is positioning itself pose in the 
unknown environment and build environment map at the same time, there are many applications such as autopilot, indoor 
and outdoor robot navigation, and 3D reconstruction. In this paper, firstly, it decomposed the basic framework of SLAM 
based on laser and summarized the mainstream algorithms of four modules from the angle of front-end scan match, 
back-end optimization, the closed loop detection and validation, and map generation; Then it analyzed and compared the 
representation scheme under two framework of SLAM, one is based on filter and the other is based on graph optimization; 
Finally, the paper point out the development trend of laser based SLAM. 
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0 引言 精确 的 地 图 ， 精 确 的 地 图 则 来 自 于 准确 的 定位 ， 定 位 侧重 自 
HYT, ERMES ET HLL SLAM 技术 历经 古典 时 代 
室内 外 导航 、 无 人 驾驶 、 增 强 现实 等 方面 的 应 用 需要 实 (1986-2004 )、 算 法 分 析 时 代 (2004-2015 )、 和 鲁 棒 性 时 代 
时 定位 搭载 传感器 的 主体 在 环境 中 的 位 姿 。 定 位 技术 虽然 已 (2015-) B1， 出 现 了 一 些 关 于 SLAM 的 综述 ， 经 典 的 例如 
有 很 多 种 ， 但 多 数 的 技术 要 么 在 实际 应 用 中 存在 诸多 局 限 ， Cadena C 等 人 J 撰写 的 文章 , 但 是 专门 针对 激光 SLAM 的 系 
要 么 代价 过 高 难以 普及 。 如 GPS 无 法 在 室内 及 严重 遮挡 的 统 总 结 则 未 能 见 到 。 本 文 专注 于 当前 激光 SLAM 算法 的 总 
室外 环境 中 使 用 ， 且 定位 精度 较 低 ;高 精度 的 惯 导 系统 成 本 — 结 ， 并 对 激光 SLAM 代表 性 方案 进行 分 析 和 比较 。 
过 高 ; 基于 无 线 信号 (“WiFi、 蓝 牙 、LED 可 见 光 ) 的 定位 方 EX "E 
案 需 事 先 布置 使 用 场景 等 。 而 基于 激光 需 达 的 同时 定位 与 1 ”激光 SLAM 关键 模块 算法 


地 图 构建 技术 (simultaneous localization and mapping, SLAM) 激光 SLAM 所 需要 的 传感器 一 般 有 激光 雷达 (Lidar)、 
以 其 准确 测量 障碍 点 的 角度 与 距离 、 无 须 预先 布置 场景 、 可 惯性 测量 单元 CIMU)、 里 程 计 〈Odometry)。 通 常 室内 采用 
融合 多 传感器 、 在 光线 较 差 环境 工作 、 能 够 生成 便于 导航 的 MS 室外 采用 三 维 激光 雷达 ， 里 程 计 采 用 轮 式 里 
环境 地 图 等 优势 ， 成 为 目前 定位 方案 中 不 可 或 缺 的 新 技术 。 程 计 。 由 于 IMU 具有 较 高 的 角速度 测量 精度 ， 相 比 IMU 里 

激光 SLAM 任务 是 搭载 激光 雷达 的 主体 于 运动 中 估计 程 计 具有 较 高 的 局 部 位 置 测量 精度 , 一 般 用 IMU 计算 角度 信 
自身 的 位 姿 ， 同 时 建立 周围 的 环境 地 图 。 而 准确 的 定位 需要 息 ， 里 程 计 计算 位 置信 息 ， 配 合 激光 雷达 进行 SLAM 过 程 。 
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七 台 河 人 ， 
主要 研究 方向 为 单 目 视觉 SLAM; IMA (1995-), 
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当前 ,激光 SLAM 框架 一 般 分 为 前 端 扫 描 匹 配 、 后 端 优 1.1.3 基于 优化 方法 (Optimization-based Method) 
化 、 闭 环 检测 、 地 图 构建 四 个 关键 模块 。 前 端 扫 描 匹 配 是 激 给 定 一 个 目标 函数 ， 把 激光 数据 扫描 匹配 问题 建 模 成 非 
光 SLAM 的 核心 步骤 , 工作 内 容 是 已 知 前 一 帧 位 姿 并 利用 相 线性 最 小 二 乘 优化 问题 ， 该 方法 帮助 限制 误差 的 累积 。 基 于 
邻 帧 之 间 的 关系 估计 当前 帧 的 位 姿 ， 前 端 扫描 匹配 能 给 出 短 优化 的 方法 最 大 问题 是 对 初 值 敏感 ， 若 初 值 选择 恰当 ， 由 于 
时 间 内 的 位 姿 和 地 图 ， 但 由 于 不 可 避免 的 误差 累积 ， 后 端 优 对 地 图 进行 插值 ， 建 图 精度 往往 会 比较 高 。 典 型 代表 是 
化 正 是 当 长 时 间 增 量 式 扫描 匹配 后 优化 里 程 计 及 地 图 信息 ; Hector-SLAM 中 中 的 匹配 方法 。 
闭环 检测 负责 通过 检测 闭环 而 减少 全 局 地 图 的 漂移 现象 ， 以 1.1.4 正 态 分 布 变换 (Normal Distribution Transformation) 
便 生 成 全 局 一 致 性 地 图 ， 地 图 构建 模块 负责 生成 和 维护 全 局 Biber P 等 人 0 提出 的 NDT 算法 ， 最 开始 作为 一 种 二 维 
地 图 。 下 面 从 算法 的 角度 分 别 对 四 个 模块 进行 总 结 。 的 匹配 方法 , 由 Magnusson M 等 人 0 将 该 算法 应 用 到 三 维 的 
1.1 前 端 扫 描 匹 配 匹配 中 ， 是 把 地 图 看 成 很 多 高 斯 分 布 的 集合 ， 不 需要 通过 搜 
目前 在 激光 SLAM 中 主流 的 扫描 匹配 算法 包括 : 迭代 最 。 索 ， 直 接 最 小 化 目标 函数 便 能 得 到 转换 关系 ， 计 算 量 小 ， 速 

符 近 点 及 变种 、 相 关 性 扫描 匹配 、 基 于 优化 方法 、 正 态 分 布 度 较 快 。NDT 方法 在 3D 激光 SLAM 与 纯 定位 中 使 用 较 多 。 
变换 、 基 于 特征 的 匹配 以 及 其 他 匹配 算法 。 下 面 对 上 述 6 种 1.1.5 基于 特征 的 匹配 (Feature-based Method) 

和 法 进行 总 结 ， 并 介绍 当 无 法 获得 较 好 初始 条 件 时 激光 数据 Fernando M 等 人 0 通过 匹配 从 激光 扫描 提取 的 特征 点 
匹配 问题 的 解决 方案 。 来 改善 计算 成 本 , 类 似 于 视觉 SLAM 中 的 基于 特征 匹配 的 方 
1.1.1 迭代 最 临近 点 (Iterative Closest Point). 及 变种 ik. Zhang J 等 人 [Sl 在 每 次 扫描 中 专注 于 边 和 平面 特征 并 将 

Chen Y 等 人 四 提出 的 ICP 算法 , 利用 待 匹 配 的 两 帧 点 它们 保存 在 地 图 中 以 进行 边线 和 平面 与 平面 的 匹配 ， 该 方法 
云 欧式 距离 最 小 化 ， 恢 复 相 对 位 姿 变 换 信息 。ICP 方法 分 为 WHT 3D 激光 SLAM. 

已 知 对 应 点 的 求解 和 未 知 对 应 点 的 求解 两 种 ， 其 中 已 知 对 应 1.1.6 其 他 匹配 方法 
点 的 情况 能 够 直接 计算 出 R 和 T 的 闭 式 解 ,而 未 知 对 应 点 的 Deschaud JE 等 人 0 基于 特定 的 采样 策略 和 扫描 到 模型 
求解 需要 进行 迭代 计算 ， 是 EM 算法 的 一 个 特例 ， 算 法 流程 Cscan-to-model) 的 匹配 方式 提出 一 种 纯 3D 激光 SLAM 算 
(如 图 1). Censi A 等 人 四 提出 ICP 变种 算法 (Point-to-Line ICP, ”法 。 在 结合 深度 学 习 方面 ，Nicolai A 等 人 05 利 用 VLP-16 采 
PL-ICP), 算 法 流程 如 图 2, 适用 于 2D 激光 SLAM.LowKL!9 Æ 3D 点 云 数据 ， 将 其 投影 到 2D 平面 生成 深度 图 像 ， 利 用 
提出 ICP 变种 算法 (Point-to-Plane ICP, PP-ICP), 适用 于 3D CNN 网 络 训练 ， 得 到 端 到 端的 匹配 结果 ， 其 运行 速度 明显 快 
激光 SLAM。ICP、PL-ICP 与 PP-ICP 比较 如 表 1 所 示 。 于 传统 ICP 匹配 方法 。 

1.1.2 相关 性 扫描 匹配 (Correlation Scan Match) 另外 ， 针 对 无 法 获得 较 好 初始 条 件 的 激光 雷达 数据 匹配 
Olson E B 等 人 tl 提出 的 CSM 算法 ， 该 算法 匹配 的 似 H, Bosse M 等 人 09 提 出 基于 投影 直方 图 和 粒 序 列 为 欠 代 
然 场 模型 高 度 非 凸 , 存在 很 多 局 部 极 值 。 由 于 进行 暴力 匹配 ， 扫描 匹配 直接 计算 初始 条 件 的 新 方法 ， 将 旋转 和 平移 估计 分 
排除 初 值 敏感 的 影响 ,这 是 与 前 面 三 种 匹配 方法 的 最 大 区 别 。 解 成 一 系列 的 相关 性 直方 图 。Checchin P. 等 人 [171 将 该 任务 视 
CSM 算法 流程 如 图 3 所 示 ， 该 方法 是 对 环境 分 辨 率 细 分 的 ， 为 影像 匹配 问题 ， 利 用 通过 毫米 波 雷 达 采 集 深度 数据 ， 经 过 
精度 会 受 限 于 分 辨 率 。 另 外 该 种 方法 能 够 通过 加 速 策略 来 降  Fourier-Mellin 变换 ， 通 过 相关 方法 对 相 邻 帧 之 间 的 刚体 变换 
低 计 算 量 ， 例 如 分 枝 定 界 方法 。 进行 自动 计算 和 全 局 估计 。 
SUE 将 当前 帧 妆 初始 位 姿 TET ESI ET de Ml p WR Ls 
寻找 对 应 点 将 0 HE 构造 — dii Hn ia 
| i 
根据 对 应 点 ， 对 当前 帧 的 点 ， 在 参考 帧 中 
计算 R, T 找到 最 近 的 两 个 点 i — Y ——À 
进行 细 分 关 素 搜索 ， 粗 分 状 率 最 优 位 姿 对 应 机 
l | 获取 最 优 位 次 
dns ud 计算 误 计算 误差 ， 别 除 离 铬 点 T 
i | 
Wanad ae 计算 误差 函数 的 迭代 增 量 WAERN 
图 1 ICP 算法 流程 图 2 PL-ICP 算法 流程 x3. CSM 算法 流程 
Fig. 1 ICP algorithm flow Fig.2 PL-ICP algorithm flow Fig.3 CSM algorithm flow 
与 上 述 全 局 策略 相反 ， 一 些 国外 的 学 者 提出 基于 遗传 算 根 距离 度量 来 极 大 的 排除 离 群 点 干扰 。 然 后 通过 变换 函数 ， 
法 的 扫描 匹配 。Martfnez J L 等 人 8 提出 使 用 一 种 解 空 间 的 ” 遗传 扫描 匹配 算法 仅 搜 索 目标 函数 的 局 部 最 小 值 ， 为 了 改善 
遗传 搜索 方法 来 获取 初始 条 件 ， 将 ICP 的 误差 度量 作为 适应 ”计算 成 本 又 提出 了 一 种 解 空间 离散 化 方法 。 
度 函 数 ， 然 后 评估 并 改变 一 组 初始 估计 直到 留 下 单个 的 主导 前 , 在 2D 激光 SLAM 中 ,最 流行 的 匹配 方法 是 CSM 
变换 。Lenac K 等 人 69 介绍 一 种 基于 相关 性 度量 的 遗传 搜索 与 梯度 优化 结合 使 用 ,典型 的 开源 方案 是 Cartographer”, 在 
去 寻找 粗略 的 初始 条 件 ， 通 过 ICP 算法 能 够 优化 遗传 搜索 的 ”3D 激光 SLAM 中 ， 最 流行 的 匹配 方法 是 基于 特征 的 匹配 ， 
结果 。Corso N 等 人 RJ 提出 了 一 种 抗 离 群 点 的 分 段 遗传 扫 接 型 的 开源 方案 是 LOAM, 
匹配 CFGSMO 算法 ， 该 算法 能 够 在 初始 条 件 较 差 的 情况 下 1.2 后 端 优化 
精确 扫描 匹配 ,首先 使 用 Phillips J M 等 人 PR1 提 出 的 分 段 均 方 在 激光 SLAM 中 , 对 于 解决 遗留 的 局 部 误差 累积 的 两 种 
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普遍 的 做 法 是 基于 滤波 器 的 后 端 和 基于 图 优化 的 后 端 P22231。 


表 1 ICP、PL-ICP、PP-ICP 三 种 算法 比较 
Table 1 Comparison of three algorithms of ICP, PL-ICP and PP-ICP 


ICP 种 类 误差 函数 收敛 速度 ”求解 精度 不 足 
计算 成 本 大 ; 由 于 激光 点 的 不 连续 
点 对 点 一 阶 性 ，ICP 会 造成 误 匹 配 引 入 额外 的 
ICP™ m 较 低 、 
距离 。 收敛 误差 ， 在 退化 环境 中 会 迅速 的 累积 


误差 中 ， 如 长 直 的 走廊 。 
较 高 ， 适 用 于 PL-ICP 相 比 ICP 对 初始 值 更 敏感 ， 
2D 激光 ”容易 陷入 局 部 极 值 ， 对 于 大 旋转 情 


Point-to-Line ”点 到 线 ”二 阶 
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ICP®! 距离 “收敛 
SLAM 况 下 算法 不 够 鲁 棒 。 
Point-to-Plane ”点 到 平 “ 二 阶 高 , 适用 于 3D 需 要 从 大 量 的 三 维 激光 点 中 提取 特 
ICp!* WER ”收敛 ”激光 SLAM 征 点 。 Ks 图 优化 后 
1.2.1 基于 滤波 器 Fig.5 After optimization 
基于 滤波 器 的 激光 SLAM 是 一 个 贝 叶 斯 估计 的 过 程 。 包 1.3 闭环 检测 与 验证 
括 里 程 计 预测 、 测 量 预 测 、 进 行 测量 、 数 据 关 联 、 状 态 更 新 1.3.1 闭环 检测 
以 及 地 图 更 新 。 下 面 对 几 种 滤波 的 形式 进行 总 结 〈 如 表 2)。 闭环 问题 是 数据 关联 问题 的 重要 一 类 ， 利 用 闭环 这 一 约 
表 2 滤波 形式 束 条 件 来 达成 拓扑 一 致 的 轨迹 地 图 ， 闭 环 检测 的 问题 是 激光 
Table2 Filter form 数据 扫描 匹配 结果 相似 性 的 问题 。 
滤波 器 形式 描述 1) 帧 与 帧 闭环 检测 (Scan-to-Scan)。 

FRZ (KF) 递归 的 线性 高 斯 系统 最 优 估 计 。 Olson E B 等 人 图 采用 的 相关 性 扫描 匹配 ,通过 旋转 和 和 平 
VICE 当 非 线性 非 高 斯 系统 时 ， 将 在 工作 点 附 移 判断 两 帧 激光 数据 的 相似 性 ， 达 到 闭环 检测 的 效果 。 但 | 
TERREWK EKO 00 近 近 似 为 线性 高 斯 进行 处 理 。 于 单 帧 激光 数据 的 信息 量 少 ， 容 易 和 其 他 相似 度 高 的 数据 发 

迭代 卡尔 曼 滤 波 (IEKF) 对 工作 点 进行 迭代 。 生 错 误 匹 配 ， 不 适用 2D 激光 SLAM. 
没有 线性 化 近似 , 而 是 把 sigma. 点 进行 2) 帧 与 子 图 闭环 检测 〈Scan-to-Map )。 
无 迹 卡 尔 曼 滤波 (UKF) 、 ED SERA 、 ACER RAS 
非 线性 变换 后 再 用 高 斯 分 布 近似 。 谷歌 的 Cartographer 通过 帧 与 子 图 的 闭环 检测 来 消除 建 
E 去 掉 高 斯 假设 ， 直 接 采 用 蒙特 卡 洛 的 方 图 过 程 中 产生 的 累积 误差 趾 。 由 Zakhor A 等 人 [3 提出 分 段 遗 
BOW CP) 二， 以 粒子 作为 采样 点 来 描述 分 布 中 。 传 扫描 匹配 算法 FGSM)》 利 用 二 维 的 激光 数据 在 闭环 约束 
在 基于 滤波 器 的 激光 SLAM 中 常常 采用 粒子 滤波 (PF) 之 间 自 动 的 估计 变换 ， 基 于 遗传 搜索 方法 以 及 特殊 建 模 离 群 


作为 数学 优化 的 框架 , 当 表达 较 小 的 尺寸 环境 时 , Tipaldi GD ” 值 的 距离 度量 ， 即 使 在 近似 的 初始 条 件 未 知 的 情况 下 也 能 提 


等 人 3! 提出 不 需要 每 个 粒子 的 栅 格 地 图 ， 能够 减少 资源 需求 供 鲁 棒 的 变换 估计 。 

量 ， 当 需要 更 新 栅 格 地 图 时 ，Strom 丁 等 人 29 建 议 计算 子 图 ， 30 子 图 与 子 图 闭环 检测 (Map-to-Map)。 

只 在 必要 时 更 新 ， 使 得 最 终 的 图 是 所 有 子 图 的 栅 格 化 。 该 种 检测 方法 改善 了 激光 数据 信息 量 少 的 缺点 ， 将 当前 
1.2.2 基于 图 优化 的 N 帧 激光 数据 整合 成 局 部 子 图 ， 与 之 前 的 子 图 进行 匹配 。 


利用 图 论 的 方式 来 表示 机 器 人 SLAM 过 程 , 将 机 器 人 的 。 在 Bosse M 等 人 19 的 工作 中 ， 对 于 全 局 匹配 利用 现 有 的 直方 
位 姿 用 节点 (Node) 表示 ， 将 节点 之 间 的 空间 约束 关系 用 边 ”图 互相 关 技 术 ， 引 入 米 序 列 投影 直方 图 和 穷 举 相关 方法 在 非 
(Edge) 表示 ， 机 器 人 在 建 图 的 过 程 中 会 积累 误差 ， 通 过 非 适用 于 大 比例 尺 环 境 的 地 图 构 
线性 最 小 二 乘 方法 来 优化 建 图 过 程 中 累积 的 误差 2729， 即 优 ， ” 建 。 文 国 成 等 人 5 提出 采用 子 地 图 与 子 地 图 匹配 的 方法 进行 
化 的 方式 同时 考虑 所 有 WAR, 迭代 线性 化 求解 。 Bosse M ”闭环 检测 ，i 通过 定位 筛选 和 压缩 表 ， 对 闭环 检测 匹配 候选 集 
等 人 (9 介绍 的 基于 图 优化 的 方法 、 局 部 扫描 到 扫描 的 匹配 以 ”优化 ， 有 效 解决 了 在 大 尺度 地 图 中 匹配 速度 缓慢 及 误 检 的 问 
及 基于 子 图 特征 的 直 方 图 的 匹配 应 用 在 室外 SLAM 的 系统 。 3i. Konolige K 等 人 B0 为 了 得 到 当前 帧 与 前 面 观 测 值 关系 ， 
如 图 4，5 分 别 为 图 优化 前 后 的 建 图 效果 。 激 光 SLAM Hag ”将 当前 帧 的 局 部 子 图 与 已 有 地 图 进行 比较 ， 利 用 基于 传感器 
最 流行 的 后 端 优化 方法 是 基于 图 优化 的 数学 框架 。 扫描 与 地 图 的 相关 性 原理 来 实现 闭环 检测 。 
Nam 45 其 他 的 闭环 检测 方法 
Olson E 等 人 5 提出 的 像素 精确 的 扫描 匹配 方法 ， 可 进 
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^ 一 步 减少 局 部 误差 的 累积 。 虽 然 计 算 成 本 更 高 ， 但 该 方法 对 
< 于 环 路 的 闭合 检测 也 很 有 用 。 在 结合 深度 学 习 的 方面 ， 
Himstedt M 等 人 63] 采 用 基于 直方 图 的 匹配 ， Nieto J I $ ABU 
DN 利用 检测 扫描 数据 中 的 特征 点 ， 并 结合 深度 学 习 方 法 进行 匹 
» o e 配 。 

YO NK SN 5) 闭环 检测 的 加 速 策 略 
ERN eS IA 谷歌 的 Cartographer 方案 提出 的 分 枝 定 界 算法 ， 分 枝 定 
TAR T CN. Jt (Branch and Bound) 算法 是 常用 的 树 型 搜索 剪 枝 算法 ， 
- 这 是 一 个 对 闭环 检测 加 速 的 策略 。 最 初 由 Land A H ABSI 
图 4 图 优化 前 在 求解 整数 规划 问题 背景 下 提出 的 , Clausen J 等 人 B61 对 分 枝 


Fig.4 Before optimization 定 界 的 原理 和 例子 进行 概述 总 结 ， 把 最 优 求解 问题 转换 为 树 
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型 搜索 问题 ， 对 于 搜索 树 中 的 每 一 个 节点 ， 确 定 以 该 节点 为 

根 节点 的 子 树 的 上 界 进行 搜索 来 达到 减 枝 加 速 的 目的 。 

1.3.2 闭环 验证 
一 般 的 闭环 检测 的 局 限 性 在 于 误 报 (false positives)， 进 
导致 错误 的 闭环 ， 降 低 建 图 系统 的 性 能 ， 造 成 恢复 地 图 后 | A 

拓扑 不 一 致 。 所 以 近年 来 一 些 国外 学 者 提出 闭环 验证 算法 。 

在 Bosse M 等 人 B71 的 工作 中 , YEAR RESO ECT EUR FE 图 6 栅 格 地 图 

列 之 间 的 最 大 相关 性 之 和 的 验证 度量 用 于 估计 闭环 检测 的 正 Fig.6 Raster map 

确 性 。 在 之 后 的 Bosse M, Zlot R 等 人 09 的 工作 中 正确 率 被 a 

提升 。 CallmerJ 等 人 B 引 的 工作 中 提出 了 一 个 基于 变换 后 扫 接 

的 最 后 配 准 的 验证 标准 。 在 非 结 构 化 的 室外 环境 下 测试 ， 对 

于 有 闭环 检测 与 闭环 验证 的 系统 正确 率 进一步 提升 

与 之 前 的 工作 不 同 ，Corso N 等 人 B0 提 出 在 室内 环境 中 
严格 处 理 闭 环 验证 。Corso N 等 人 认为 闭环 可 以 从 很 多 数据 os 

源 中 被 检测 到 ,因此 将 闭环 验证 算法 与 闭环 检测 算法 相 分 离 。 7 特征 地 图 

针对 室内 的 退化 环境 , 由 于 在 激光 数据 中 缺少 明显 的 特征 点 ， Fig.7 Feature map 

个 既 能 表征 场景 复杂 性 又 能 表征 几何 对 齐 的 验证 度 
训 用 简单 的 闵 值 方案 ， 能 够 自动 防止 错误 的 环 路 闭合 而 

构建 几何 不 一 致 的 地 图 。 经 过 端 到 端的 测试 ， 该 方法 能 够 应 

各 种 各 样 的 基于 2DLIDAR 的 闭环 系统 。 

目前 , 激光 SLAM 最 流行 的 闭环 检测 方法 是 帧 与 地 图 之 

闻 的 匹配 ， 利 用 分 枝 定 界 策 略 加 速 匹 配 速度 以 及 结合 延 时 决 


iv 合作 期 乔 


DE 


策 (Lazy Decision) 保证 匹配 的 准确 性 。 
1.4 地 图 构建 A8 点 云 地 图 
SLAM 构建 的 地 图 是 传感器 周围 环境 的 模型 ， 是 机 器 人 Fig.8 Point cloud map 


进行 定位 和 路 径 规划 的 前 提 。 在 SLAM 领域 , 构建 的 地 图 主 
要 分 为 三 类 : 尺度 地 图 、 拓 > 扑 地 图 以 及 语义 地 图 (如 表 3)。 
为 强调 基于 激光 SLAM 系统 中 建 图 的 实时 性 , 地 图 构建 
模块 通常 采用 计算 量 较 少 的 占据 栅 格 建 图 算法 ， 是 基于 贝 叶 
斯 估计 的 方式 。 
5 据 栅 格 地 图 B9 把 环境 分 解 成 一 个 个 栅 格 ， 栅 格 是 二 元 


zx 


随机 变量 ， 有 占据 或 空闲 两 种 状态 。 占 据 栅 格 地 图 中 的 每 一 
个 栅 格 是 独立 的 ， 估 计 环 境 的 地 图 只 需要 对 每 一 个 独立 的 图 9 语义 地 图 
格 进行 估计 ， 该 算法 对 某 一 个 栅 格 进行 操作 时 ， 只 有 加 法 计 Fig.9 Semantic map 


和 ， 因 此 有 具有 非常 高 的 更 新 速度 ， 更 新 地 图 时 ， 需 要 知道 传 dan : 
感 器 的 逆 观 测 模型 。 占 据 栅 格 地 图 以 周围 环境 是 否 被 遮挡 来 2 WC SLAM 方案 对 比 

鲜明 区 分 可 通行 区 域 ， 适 用 于 避 障 与 导航 路 径 规划 。 根据 所 采用 的 数学 优化 框架 ， 激 光 SLAM 可 分 为 两 大 
目前 ， 无 论 是 2D 激光 SLAM 还 是 3D Wok SLAM, 应 Æ: 基于 滤波 器 (Filter-based) 和 基于 图 优化 (Graph-based) 
用 最 广泛 的 地 图 种 类 是 占据 栅 格 地 图 。 另 外 实际 应 用 中 在 评 的 激光 SLAM。 下 面 分 别 介 绍 两 种 框架 下 的 激光 SLAM 方案 。 
定 基 于 激光 SLAM 建 图 的 精度 指标 时 可 以 分 别 与 全 站 仪 、 钢 21 基于 滤波 器 的 激光 SLAM 方案 

尺 、 地 面 式 激光 扫描 仪 进行 比较 ， 将 标记 球 中心 的 点 位 误差 Smith R 等 人 提出 的 扩展 卡尔 曼 滤波 SLAM 方案 
作为 一 个 精度 指标 ， 将 特征 物体 尺寸 的 中 误差 作为 一 个 精度 CEKF-SLAM) 50， 使 用 最 大 似 然 算 法 进行 数据 关联 ， 该 方 
H 


指标 ， 将 点 云 模型 的 配 准 误差 作为 一 个 精度 指标 [9 案 的 缺点 是 计算 量 复杂 ， 重 棒 性 较 差 ， 构建 的 地 图 是 特征 地 
表 3 三 种 地 图 种 类 图 而 不 是 栅 格 地 图 ， 无 法 应 用 在 导航 避 障 上 。 

Table 3 Three types of maps 针对 EKF-SLAM 方案 的 不 足 ，Montemerlo M 等 人 提出 
地 图 种 类 描述 了 FastSLAM JRI, 该 方案 将 SLAM 问题 分 解 成 机 器 人 定 
构建 的 地 图 与 实际 环境 尺度 保持 一 致 ， 栅 格 地 图 立 问题 和 基于 已 知 机 器 人 位 姿 的 构图 问题 ， 是 最 早 能 够 实时 
尺度 地 图 (如 图 6)、 特 征地 图 (如 图 7)、 点 云 地 图 (如 图 输出 顶 格 地 图 的 激光 SLAM 方案 。 用 粒子 滤波 来 估计 机 器 人 
8) 都 属于 尺度 地 图 。 位 姿 ， 将 每 个 粒子 用 运动 学 模型 进行 传播 ， 对 于 传播 后 的 粒 
— 表示 连通 关系 ， 包 括 是 否 连 通 以 及 距离 大 小 ， 适 子 用 观测 模型 进行 权重 计算 并 根据 估计 的 位 姿 构 建 地 图 。 该 
于 大 尺度 环境 下 的 路 径 规 划 。 方案 存在 两 个 问题 ， 第 一 ， 由 于 每 个 粒子 包含 机 器 人 的 轨迹 
语义 地 加 标签 的 尺度 地 图 ， 强 调 地 图 中 对 象 与 对 象 之 间 和 对 应 的 环境 地 图 ， 对 于 大 尺度 环境 ， 若 里 程 计 误差 较 大 即 
ide 的 描述 性 (如 图 95. 预测 分 布 与 真实 分 布 差异 较 大 ， 则 需要 较 多 粒子 来 表示 机 器 
人 位 姿 的 后 验 概 率 分 布 ， 严 重 消耗 内 存 ; 第 二 ， 由 于 重 采 样 
的 随机 性 ， 随 着 重 采 样 次 数 增多 ， 粒 子 多 样 性 散失 ， 粒 子 耗 

散 问题 会 严重 影响 地 图 的 构建 。 
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为 了 对 FastSLAM 方案 进行 优化 ，Grisetti G 等 人 提出 
Gmapping JRI, VA FastSLAM 方案 为 基本 原理 ， 在 较 小 
的 环境 中 能 实现 较 好 的 建 图 效果 ,是 目前 使 用 最 为 广泛 的 2D 
激光 SLAM 方案 ， 建 图 效果 如 图 10 所 示 。 为 了 解决 内 存 消 
耗 严 重 问题 ， 将 粒子 的 数量 保持 在 一 个 比较 小 的 数值 ， 对 预 
测 分 布 采 样 ， 然 后 基于 优化 扫描 匹配 来 优化 位 姿 。 对 于 缓解 
粒子 耗 散 问题 ， 采 用 减少 重 采样 次 数 ， 用 一 个 度量 表示 预测 
分 布 与 真实 分 布 的 差异 性 , 当 差 异性 很 小 时 , 不 进行 重 采样 ， 
当 差 异性 很 大 时 ， 进 行 重 采样 。 该 方案 不 足 是 在 里 程 计 模 型 
在 传播 时 ， 对 所 有 的 粒子 同等 对 待 ， 优 的 粒子 在 传播 时 可 能 
变 成 差 的 粒子 ， 粒 子 退 化 问题 严重 。 因 此 Gmapping 方案 非 
常 依赖 于 里 程 计 人 信息， 构建 的 地 图 也 取决 于 里 程 计 的 精度 。 
针对 Gmapping 方案 的 不 足 ，Blanco J L 等 人 在 2010 年 
是 出 了 更 加 优化 的 Optima RBPF 方案 (时 ， 其 在 里 程 计 模型 
传播 时 , 一 个 粒子 每 次 传播 会 得 到 N 个 粒子 , YEN 个 粒子 里 
机 选择 最 优 粒 子 ， 作 为 此 次 的 真实 传播 ， 相 当 于 每 个 粒子 给 
了 N 次 机 会 ,大 大 减少 最 优 粒子 退化 为 噪声 很 大 的 粒子 情况 。 


图 10 Gmapping 方案 
Fig. 10 Gmapping scheme 

2.2 基于 图 优化 的 激光 SLAM 方案 
在 激光 雷达 领域 ，Lu F, Milios E 等 人 tM 首次 提出 利用 
图 优化 Cgraph-based optimization) 的 数学 框架 优化 SLAM 问 
题 ,通过 非 线 性 最 小 二 乘 方 法 来 优化 建 图 过 程 中 累积 的 误差 。 
其 存在 的 问题 在 于 没有 认识 到 系统 的 稀疏 性 ， 离 线 处 理 
SLAM 问题 。 由 Gutmann 本 等 人 9 提出 的 图 优化 框架 与 当前 
的 图 优化 框架 相似 ， 包 括 局 部 扫描 匹配 、 全 局 优化 、 以 及 子 
图 与 子 图 的 闭环 检测 , 不足 是 同样 没有 认识 到 系统 的 稀 玻 性 ， 
并 非 实 时 SLAM. 

为 了 进一步 改善 前 面 工作 的 不 足 ，Konolige K 等 人 的 提 
出 首 个 基于 图 优化 框架 的 开源 方案 Karto SLAM， 该 方案 认 
识 到 了 系统 稀疏 性 ， 在 一 定 程度 上 替代 了 基于 滤波 器 的 激光 
SLAM 方案 。 该 方案 的 不 足 是 采用 局 部 子 图 匹配 之 前 都 要 构 
建 子 图 ， 耗 费时 间 较 长 ， 若 采用 全 局 匹配 方法 ， 则 在 搜索 范 
围 大 的 时 候 速度 会 变 慢 。 

谷歌 的 Cartographer FINI R, Xf Karto SLAM 的 优 
化 方案 ， 核 心 内 容 是 融合 多 传感器 数据 的 局 部 子 图 创建 以 及 
用 于 闭环 检测 的 扫描 匹配 策略 ， 建 图 效果 如 图 11 所 示 。 该 方 
案 中 前 端 扫描 匹配 算法 是 结合 CSM 与 梯度 优化 来 实现 的 。 
在 生成 一 个 子 地 图 后 ， 会 进行 一 次 局 部 的 闭环 检测 ， 当 全 部 
子 地 图 构建 完成 后 ,利用 分 枝 定 界 和 预先 计算 的 网 格 的 算法 ， 
进行 全 局 闭环 检测 ， 从 而 保证 闭环 检测 的 速度 。 该 方案 的 不 
足 是 没有 对 闭环 检测 结果 进行 验证 ， 在 几何 对 称 的 环境 中 
容易 引起 错误 的 闭环 。 

另外 ，Kohlbrecher S 等 人 提出 了 Hector-SLAM 方案 中， 
该 方案 利用 高 斯 牛顿 方法 解决 前 端 扫描 匹配 问题 ， 把 每 一 帧 
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采集 到 的 激光 雷达 数据 和 地 图 进行 匹配 ， 该 方案 仅 有 前 端 扫 
描 匹 配 的 模块 ， 无 后 端 优化 的 过 程 。 与 Gmapping 方案 最 大 
的 区 别 在 于 不 需要 里 程 计 数据 ， 里 程 计 信 息 通 过 激光 雷达 数 
据 估 算出 来 ， 所 以 对 传感器 的 测量 频率 要 求 较 高 。 在 ROS 
仿真 环境 中 运行 Hector-SLAM 方案 , 若 机 器 人 速度 过 快 尤其 
是 在 强 旋转 的 时 候 ，Hector-SLAM 方案 会 发 生 漂移 现象 ， 如 
图 12 所 示 。 在 真实 环境 中 , 由 于 周围 特征 点 能 够 辅助 机 器 人 
定位 和 建 图 ， 构 建 的 栅 格 地 图 会 比 仿真 环境 中 效果 好 ， 建 图 
效果 如 图 13 所 示 。Hector-SLAM 方案 的 缺点 是 对 初 值 敏感 ， 
同时 难以 处 理 闭环 问题 。Hector-SLAM 的 整体 建 图 精度 高 于 
Gmapping， 但 对 参数 配置 要 求 较 高 。Hector -SLAM 适用 于 


对 地 图 要 求 较 高 的 场合 ，Gmapping 易 用 性 更 好 的 1。 


| > 
ipg 


图 11 Cartographer 方案 


Fig. 11 Cartographer scheme 


图 12 Hector-SLAM 漂移 
Fig. 12 Hector-SLAM drift 


图 13 Hector-SLAM 方案 
Fig. 13 Hector-SLAM scheme 


在 3D 激光 SLAM 领域 中 ， 由 Zhang J 等 人 03] 提 出 的 
LOAM 方案， 利用 3D 激光 雷达 采集 数据 ， 进 行 基于 特征 点 
的 扫描 匹配 ， 利 用 非 线 性 优化 方法 进行 运动 估计 ， 激 光 里 程 
计 的 输出 与 地 图 进行 匹配 ， 包 括 直线 匹配 和 平面 匹配 ， 无 回 
环 检测 模块 ， 点 面 特征 还 不 够 可 靠 。LOAM 方案 的 框架 如 图 
14 所 示 。 

为 了 进一步 改进 LOAM 方案 的 , Zhang) 5 AUSH Hi 
觉 结合 3D 激光 雷达 实时 建 图 的 V-LOAM 方案 (如 图 15)。 
利用 视觉 里 程 计 以 高 频率 估计 位 姿 变换 ， 激 光 里 程 计 以 低频 
率 优化 运动 估计 ， 并 校准 漂移 。 在 公开 的 KITTI 数据 集 上 ， 
V-LOAM 算法 精度 排名 第 一 ， 而 且 当 传感器 高 速 运动 并 受到 
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明显 的 光照 变化 时 ， 该 方法 的 鲁 棒 性 较 好 。 
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图 14 LOAM 方案 框架 
Fig. 14 LOAM scheme framework 


rE 


| oci 


出 地 图 


R15 WV-LOAM 方案 框架 
Fig.15  V-LOAM scheme framework 


Daniel Lawrence Lu 等 人 的 提出 增强 视觉 结合 激光 雷达 
的 VELO 新 方案 ， 通 过 紧 耦 合 的 稀疏 视觉 与 激光 数据 进行 前 


端 扫描 匹配 ， 利 用 
VELO 
够 可 靠 运行 。 


立 姿 图 的 稀疏 性 进一步 优化 位 姿 误 差 。 
有 低 漂 移 性 同时 当 激 光 雷 达 或 相机 数据 被 遮挡 时 能 


Deschaud J E 等 人 [4 基于 特定 的 采样 策略 和 扫描 到 模型 
(Cscan-to-model) 的 匹配 方式 提出 一 种 纯 3D 激光 SLAM 算 


YA 


Zhang J 等 人 050 提出 了 一 种 ) 
数据 处 理 方案 LVIO (如 图 16 )。 
仪 ， 相 机 和 IMU， 顺 序 多 层 运 行 三 个 模块 以 产 委 


动 估计 。 粗 到 精 数据 处 理 产生 高 速率 估计 并 在 长 距离 中 构建 


低 漂移 的 地 图 。 


于 自我 运动 估计 和 建 图 的 
该 方案 连接 3D 激光 扫描 


E 实 时 自我 运 


图 16 LVIO 方案 框架 
Fig. 16 LVIO scheme framework 
下 面 对 几 种 激光 SLAM 方案 进行 总 结 ， 


3 ”发 展 趋势 


如 表 4 所 示 。 


当前 ， 激 光 SLAM 发 展 趋势 主要 涵盖 以 下 三 个 方面 : 


1) 深度 学 习 在 激光 SLAM 的 应 用 。 


例如 Nicolai A 等 人 


0 将 前 端 扫描 匹配 与 深度 学 习 结 合 ， 利 用 CNN 网 络 训练 ， 


得 到 端 到 
融合 。 邹 勤 50 将 闭环 检测 模块 与 深度 学 习 结 合 ， 
度 Hash 
度 ， 实 现 相 似 样本 的 快速 检索 。 而 SLAM 


端的 帧 闻 估 计 结 果 ， 实 现 了 高 维 传感器 数据 处 理 与 


构建 一 种 深 


网 络 对 激光 点 云 样本 进行 Hash 编码 并 计算 样本 相似 
中 后 端 模 块 是 状态 


估计 问题 ， 有 明确 的 数学 模型 做 支撑 ， 因 此 ， 深 度 学 习 端 到 


传感器 ， 配 合 深度 学 习 领 域 中 物体 检测 、 


端的 贯穿 整个 SLAM 系统 将 会 有 极 大 的 挑战 。 此 外 ， 融 合 多 
识别 和 解析 算法 ， 
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方向 。 
RA 几 种 激光 SLAM 方案 
Table 4 Several laser SLAM schemes 
年 份 方案 传感器 优 缺 点 
1988 4 — EKF-SLAM"" ”2D 激光 构建 特征 地 图 ， 计 算 量 复 杂 ， 鲁 棒 性 较 差 。 
最 早 实 时 输出 栅 格 地 图 ， 消 耗 内 存 ， 粒 子 耗 
2002 年  FastSLAM"” 2D 激光 
散 严重 。 
2007 ££ — Gmapping'?! 2D 激光 ”缓解 粒子 耗 散 ， 非 常 依赖 于 里 程 计 信息 。 
2010 4E Optimal RBPF! — 2D 激光 进一步 减少 粒子 退化 问题 。 
首 个 基于 图 优化 框架 开源 方案 ， 认 识 到 稀疏 
2010 年 Karto SLAM?” ”2D 激光 
性 ， 耗 费时 间 。 
不 需要 里 程 计数 据 ， 强 旋转 漂移 ， 初 值 敏感 ， 
2011 年 ”Hector-SLAMI — 2D 激光 
难处 理 闭环 。 
2014 年 LOAM!" 3D 激光 ”实时 性 好 ， 匀速 运动 假设 ， 无 闭环 检测 。 
3D 激光 、 视 精度 高 ， 算 法 鲁 棒 性 好 ， 漂 移 匀速 假设 ， 无 
2015 年 V-LOAM'!! 
觉 闭环 检测 。 
CSM 与 梯度 优化 的 前 端 ， 图 优化 的 后 端 ， 加 
2016 年 。 Cartographer"! 2D 激 》 
速 的 闭环 检测 。 
D 激光 、 视 
2016 年 VELO?! 有 闭环 检测 模块 ， 低 漂移 ， 无 运动 畸变 假设 。 
不 依赖 于 GPS、IMU、 相 机 等 传感器 ， 低 漂 
2018 年 IMLS09 3D 激光 
移 。 
3D 激光 、 视 低 漂 移 ， 光 照 、 旋 转 、 结 构 退 化 环境 下 鲁 棒 
2018 年 LVIOP?! 
觉 性 极 好 。 


2) 面 对 复 杂 的 周围 环境 ， 多 传感器 融合 的 SLAM 是 


视觉 会 提供 高 精度 的 里 程 计 以 及 信息 量 丰 富 的 地 


期 


重建 5 是 未 来 SLAM 的 重要 


DA 


信息 , 激光 雷达 为 视觉 特征 提供 准确 的 深度 信息 。 例 如 BokY 
等 人 [53] 以 松 耦 合 和 图 优化 方式 融合 2D 激光 雷达 , GPS 与 
用 于 文物 保护 的 室外 SLAM Xi. Shen S $ ABA 


机 数据 ， 


与 Lynen S 等 人 551 两 者 均 提 出 紧 耦 合 的 EKF 估计 器 , 用 于 
合 多 传感器 信息 的 MAV 系统 。 
3) SLAM 算法 的 鲁 棒 性 与 实时 性 


相 


提高 SLAM 算法 的 鲁 棒 性 方面 ， 需 要 考虑 里 程 计 的 标定 、 
光 雷 达 的 外 参与 时 间 惟 标定、 激光 雷达 运动 畸变 的 去 除 等 数 
据 处 理 过 程 ， 同 时 针对 退化 环境 、 全 局 定位 、 动 态 环境 定 
等 问题 还 有 待 完善 。 例 如 Corso N 等 人 2 设计 背包 SLAM 
统 时 ， 提 出 激光 雷达 与 惯性 传感器 之 间 直 接 在 线 进行 外 参 标 


定 和 时 间 标 定 。 石 鹏 等 人 59 
方法 。 Zhang J 等 人 [50 提出 用 于 自我 运动 


古 计 并 构建 地 图 


数据 处 到 
和 结构 退化 、 以 及 高 速 旋转 与 平移 运动 有 较 好 的 鲁 棒 性 。 
是 高 SLAM 算法 的 实时 性 方面 
频率 的 模块 并 行 运算 ， 保 证 低 计算 复杂 度 的 同时 实现 实 


I B 


方法 ， 该 方法 对 于 各 个 传感器 故障 、 剧 烈 光 照 变 


，Zhang 本 等 人 657 提 出 两 种 


的 低 漂 移 里 程 计 .Park C 等 人 68 


提出 了 一 种 稠密 的 以 地 图 


中 心 的 CTSLAM 新 方法 ，| 
系统 的 实时 性 和 长 
的 局 部 地 图 和 分 层 的 优化 后 端 ， 
激光 SLAM 方法 ， 
上 述 发 展 趋势 将 把 激光 SLAM 方案 从 实验 室 引入 工 


于 多 模块 传感器 融合 ， 提 高 


期 适用 性 。 5] 基于 高 


Droeschel D 等 


允许 实时 建 图 期 间 优 化 配 准 。 


实践 中 ， 使 移动 机 器 人 更 加 智能 化 。 
4 ”结束 语 

随 着 3D 固态 激光 雷达 技术 的 成 熟 与 深度 学 习 理论 的 
入 发 展 ， 越 来 越 多 低 成 本 激光 雷达 被 民用 化 ， 同 时 将 会 


融 


在 
激 


位 


系 


是 出 在 动态 环境 下 激光 SLAM 


的 
化 
在 
不 
时 
为 
f 
效 


提出 了 分 层 、 连 续 时 间 的 3D 


程 


深 


ju 


加 和 鲁 棒 的 激光 SLAM 算法 随 之 产生 ， 以 激光 SLAM 为 基础 
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的 技术 会 被 广泛 的 应 用 在 室内 外 导航 、 无 人 驾驶 、 以 及 实时 


EU di^ 


FJ [HI o 
参考 文献 : 


[1] 刘 浩 敏 ， 章 国 锋 ， 鲍 虎 军 . 基于 单 目 视觉 的 同时 定位 与 地 图 构建 方 
法 综述 [J]. 计算 机 辅助 设计 与 图 形 学 学 报 ,2016, 28 (6): 855-868. 


(Liu Haomin, Zhang Guofeng, Bao Hujun. A survey of monocular 
simultaneous localization and mapping [J]. Journal of Computer-Aided 
Design & Computer Graphics, 2016, 28 (6): 855-868. ) 

[2] 高翔, 张涛， 等 . 视觉 SLAM 十 四 讲 [M]. 北京 : 电子 工业 出 版 社 ， 
2017. (Gao Xiang, Zhang Tao, et al. The fourteen lectures on visual 
SLAM [M]. Beijing: Publishing House of Electronics Industry, 2017. ) 

[B] Cadena C, Carlone L, Carrillo H, et al. Past, present, and future of 
simultaneous localization and mapping: toward the robust-perception 
age [J]. IEEE Transactions on Robotics, 2016, 32 (6): 1309-1332. 

[4] Chen Y, Medioni G. Object modelling by registration of multiple range 
images [J]. Image & Vision Computing, 1992, 10 (3): 145-155. 

[5] Censi A. An ICP variant using a point-to-line metric [C]// Proc of IEEE 
International Conference on Robotics and Automation. Piscataway, NJ: 
IEEE Press, 2008: 19-25. 

[6] Low K L. Linear least-squares optimization for point-to-plane ICP 
surface registration, TRO4-004 [R]. North Carolina: University of North 
Carolina at Chapel Hill, 2004. 

[7] Hess W, Kohler D, Rapp H, et al. Real-time loop closure in 2D lidar 
SLAM [C]// Proc of IEEE International Conference on Robotics and 
Automation. Piscataway, NJ: IEEE Press, 2016: 1271-1278. 

[8] Olson E B. Real-time correlative scan matching [C]// Proc of IEEE 
International Conference on Robotics and Automation. Piscataway, NJ: 
IEEE Press, 2009: 4387-4393. 

[9] Kohlbrecher S, Stryk O V, Meyer J, et al. A flexible and scalable SLAM 
system with full 3D motion estimation [C]// Proc of IEEE International 
Symposium on Safety Security and Rescue Robotics. Piscataway, NJ: 
IEEE Press, 2011: 155-160. 

[10] Biber P, Strasser W. The normal distributions transform: a new 
approach to laser scan matching [C]// Proc of IEEE//RSJ International 
Conference on Intelligent Robots and Systems. Piscataway, NJ: IEEE 
Press, 2003: 2743-2748. 

[11] Magnusson M. The  three-dimensional normal distributions 
transform-an efficient representation for registration, surface analysis, 
and loop detection [J]. Renewable Energy, 2009, 28 (4): 655-663. 

[12] Fernando M, Rudolph T, Luis M, et al. Two different tools for 
three-dimensional mapping: de-based scan matching and feature-based 
loop detection [J]. Robotica, 2014, 32 (1): 19-41. 

[13] Zhang J, Singh S. LOAM: lidar odometry and mapping in real-time 
[C/OL]| Proc of Robotics: Science and Systems. (2014-07-12) 
[2018-08-12]. http://www. roboticsproceedings. org/rss10/p07. pdf. 

[14] Deschaud J E. IMLS-SLAM: scan-to-model matching based on 3D data 
[C]/ Proc of IEEE International Conference on Robotics and 
Automation. Piscataway, NJ: IEEE Press, 2018: 2480-2485. 

[15] Nicolai A, Skeele R, Eriksen C, et al. Deep learning for laser based 
odometry estimation [J/OL]. (2016) [2018-10-16]. http://juxi. 
net/workshop/deep-learning-rss-2016/papers/Nicolai?620-26020Deep 962 
OLearning9620Lidar?620Odometry. pdf. 

[16] Bosse M, Zlot R. Map matching and data association for large-scale 
two-dimensional laser scan-based SLAM  [J/OL]. (2008-06-01) 
[2018-08-12]. com/doi/abs/10. 


http://journals. sagepub. 


基于 激光 雷达 的 同时 定位 与 地 图 构建 方法 综述 


Wi 
第 37 卷 第 2 期 


1177/0278364908091366. 

[17] Checchin P, Gérossier F, Blanc C, et al. Radar scan matching SLAM 
using the fourier-mellin transform [J]. Field and Service Robotics, 2010, 
62 (7): 151-161. 

[18] Martínez J L, González J, Morales J, et al. Mobile robot motion 
estimation by 2D scan matching with genetic and iterative closest point 
algorithms [J]. Journal of Field Robotics, 2010, 23 (1): 21-34. 

[19] Lenac K, Mumolo E, Nolich M. Robust and accurate genetic scan 
matching algorithm for robotic navigation [M]// Intelligent Robotics 
and Applications. Berlin: Springer, 2011: 584-593. 

[20] Corso N. Sensor fusion and online calibration of an ambulatory 
backpack system for indoor mobile mapping, UCB//EECS-2016-81 [R]. 
California: University of California, Berkeley, 2016. 

[21] Phillips J M, Liu R, Tomasi C. Outlier robust ICP for minimizing 
fractional RMSD [C]// Proc of the 6th International Conference on 3-D 
Digital Imaging and Modeling. Piscataway, NJ: IEEE Press, 2007: 
427-434. 

[22] Konolige K, Grisetti G, Kümmerle R, et al. Efficient sparse pose 
adjustment for 2D mapping [C]// Proc of IEEE//RSJ International 
Conference on Intelligent Robots and Systems. Piscataway, NJ: IEEE 
Press, 2010: 22-29. 

[23] Grisettiyz G, Stachniss C, Burgard W. Improving grid-based SLAM 
with Rao-Blackwellized Particle Filters by adaptive proposals and 
selective resampling [C]// Proc of IEEE International Conference on 
Robotics and Automation. Piscataway, NJ: IEEE Press, 2005: 
2432-2437. 

[24] Barfoot TD. State estimation for robotics [M]. Cambridge: Cambridge 
University Press, 2017. 

[25] Tipaldi G D, Braun M, Kai O A. Interest regions for 2D range data with 
applications to robot navigation [J]. Springer Tracts in Advanced 
Robotics, 2014, 79 (1): 695-710. 

[26] Strom J. Occupancy grid rasterization in large environments for teams 
of robots [C]// Proc of IEEE//RSJ International Conference on 
Intelligent Robots and Systems. Piscataway, NJ: IEEE Press, 2011: 
4271-4276. 

[27] Kümmerle R, Grisetti G, Strasdat H, et al. G20: a general framework for 
graph optimization [C]// Proc of IEEE International Conference on 
Robotics and Automation. Piscataway, NJ: IEEE Press, 2011: 
3607-3613. 

[28] Carlone L, Aragues R, Castellanos J A, et al. A fast and accurate 
approximation for planar pose graph optimization [J]. International 
Journal of Robotics Research, 2014, 33 (7): 965-987. 

[29] Zakhor A. Loop closure transformation estimation and verification 
using 2D lidar scanners, UCB//EECS-2013-73 [R]. California: 
University of California, Berkeley, 2013. 

[30] LAR, XE, RAR., 一 种 适用 于 激光 SLAM 大 尺度 地 图 的 闭环 
检测 方法 Un 计算 机 应 用 研究 ，2018，35 (6): 1724-1727. (Wen 
Guocheng, Zeng Bi, Chen Yunhua. Loop closure detection method for 
large scale map of laser SLAM [J]. Application Research of Computers, 
2018, 35 (6): 1724-1727. ) 

[31] Konolige K, Chou K. Markov localization using correlation [C]// Proc 
of the 16th International Joint Conference on Artificial Intelligence. San 
Francisco: Morgan Kaumann, 1999: 1154-1159. 

[32] Olson E. M3RSM: many-to-many multi-resolution scan matching [C]// 
Proc of the IEEE International Conference on Robotics and Automation. 


Piscataway, NJ: IEEE Press, 2015: 5815-5821. 


录用 定稿 


第 37 卷 第 2 期 


危 双 丰 ， 等 : 基于 激光 雷达 的 同时 定位 与 地 图 构建 方法 综述 


[33] Himstedt M, Frost J, Hellbach S, et al. Large scale place recognition in 
2D lidar scans using geometrical landmark relations [C]// Proc of 
IEEE//RSJ International Conference on Intelligent Robots and Systems. 
Piscataway, NJ: IEEE Press, 2014: 5030-5035. 

[34] Nieto J I, Ramos F T. Learning to close loops from range data [J]. 
International Journal of Robotics Research, 2011, 30 (14): 1728-1754. 

[35] Land A H, Doig A G An automatic method of solving discrete 
programming problems [J]. Econometrica, 1960, 28 (3): 497-520. 

[36] Clausen J. Branch and bound algorithms-principles and examples [J]. 
Parallel Processing Letters, 1999, 22 (5): 658-663. 

[37] Bosse M, Roberts J. Histogram matching and global initialization for 
laser-only SLAM in large unstructured environments [C]// Proc of IEEE 
International Conference on Robotics and Automation. Piscataway, NJ: 
IEEE Press, 2007: 4820-4826. 

[38] Callmer J, Ramos F, Nieto J. Learning to detect loop closure from range 
data [C]// Proc of IEEE International Conference on Robotics and 
Automation. Piscataway, NJ: IEEE Press, 2009: 1990-1997. 

[39] Thrun S, Burgard W, Fox D. Probabilistic robotics [M]. Cambridge: 
MIT Press, 2005: 213-232. 

[40] 俞 德 央 ， 李 广 云 , EH, 5. 激光 SLAM 测 图 精度 评定 [C/OL]/ 第 
九 届 中 国 卫星 导航 学 术 年 会 . [2018-08-12]. http://cpfd. cnki. com. 
cn/Article/CPFDTOTAL-ZKBD201805009045. htm. (Yu Deqi, Li 
Guangyun, Wang Li, et al. Laser SLAM mapping precision assessment 
[C/OL]/ Proc of the 9th China Satellite Navigation Academic Annual 

[2018-08-12]. 

cn/Article/CPFDTOTAL-ZKBD201805009045. htm. ) 


Meeting. http://cpfd. enki. com. 
[41] Smith R, Self M, Cheeseman P. Estimating uncertain spatial 
relationships in robotics [J]. 
Recognition, 1988, 5 (5): 435-461. 
[42] Montemerlo M, Thrun S, Koller D, et al. FastSLAM: a factored 


Machine Intelligence & Pattern 


solution to the simultaneous localization and mapping problem [C]// 
Proc of the AAAI National Conference on Artificial Intelligence. 
California: AAAI press, 2002: 593-598. 

[43] Grisetti G, Stachniss C, Burgard W. Improved techniques for grid 
mapping with Rao-Blackwellized Particle Filters [J]. IEEE Trans on 
Robotics, 2007, 23 (1): 34-46. 

[44] Blanco J L. Optimal filtering for non-parametric observation models: 
applications to localization and SLAM [M]. Los Angeles: Sage 
Publications, Inc. 2010. 

[45] Lu F, Milios E. Globally consistent range scan alignment for 
environment mapping [J]. Autonomous Robots, 1997, 4 (4): 333-349. 

[46] Gutmann J S, Konolige K. Incremental mapping of large cyclic 
environments [C]// Proc of IEEE International Symposium on 
Computational Intelligence in Robotics and Automation. Piscataway, NJ: 
IEEE Press, 1999: 318-325. 

[47] & X 5t, PER, JUR, F. 两 种 基于 激光 雷达 的 SLAM 算 法 最 优 
参数 分 析 Dl. 传感器 与 微 系 统 , 2018, 37 (4): 28-30. (Gao Wenyan, 


Ping Xueliang, Bei Xuying, et al. Optimal parameter analysis of two 


SLAM algorithms based on laser radar [J]. Transducer and Microsystem 
Technologies, 2018, 37 (4): 28-30. ) 

[48] Zhang J, Singh S. Visual-lidar odometry and mapping: low-drift, robust, 
and fast [C]// Proc of IEEE International Conference on Robotics and 
Automation. Piscataway, NJ: IEEE Press, 2015: 2174-2181. 

[49] Daniel Lawrence LU. Vision-enhanced lidar odometry and mapping [D]. 
Pittsburgh: Carnegie Mellon University, 2016. 

[50] Zhang J, Singh S. Laser-visual-inertial odometry and mapping with 
high robustness and low drift [J/OL]. (2018-07-09) [2018-10-20]. 
https://doi. org/10. 1002/rob. 21809. 

[51] 35 3g. 一 种 基于 深度 学 习 的 激光 SLAM 闭环 检测 方法 : 中 国 ， 
CN107403163A [P]. 2017-11-28. (Zhou Qin. Laser SLAM closed-loop 
detection method based on deep learning: China, CN1074031634A [P]. 
2017-11-28. ) 

[52] S&H. 深度 相机 SLAM 的 特征 学 习 与 语义 地 图 构建 算法 研究 [D]. 
北京 : 清华 大 学 ,2017. (Gao Xiang. Feature learning and semantic map 
reconstruction in RGB-D SLAM [D]. Beijing: Tsinghua University, 
2017.) 

[53] Bok Y, Jeong Y, Choi D G, et al. Capturing village-level heritages with 
a hand-held camera-laser fusion sensor [J]. International Journal of 
Computer Vision, 2011, 94 (1): 36-53. 

[54] Shen S, Mulgaonkar Y, Michael N, et al. Multi-sensor fusion for robust 
autonomous flight in indoor and outdoor environments with a rotorcraft 
MAV [C]// Proc of IEEE International Conference on Robotics and 
Automation. Piscataway, NJ: IEEE Press, 2014: 4974-4981. 

[55] Lynen S, Achtelik M W, Weiss S, et al. A robust and modular 
multi-sensor fusion approach applied to MAV navigation [C]// Proc of 
IEEE/RSJ International Conference on Intelligent Robots and Systems. 
Piscataway, NJ: IEEE Press, 2013: 3923-3929. 

[56] A0, B de, XA ERE, 等 . 动态 环境 下 基于 激光 雷达 的 SLAM 方法 : 
中 国 , CN107991680A [P]. 2018. 05. 04. (Shi Peng, Lv Pin, Lai Jizhou, 
et al. Lidar based SLAM method in dynamic environment: China, 
CN107991680A [P]. 2018. 05. 04. ) 

[57] Zhang J, Singh S. Low-drift and real-time lidar odometry and mapping 
[J]. Autonomous Robots, 2017, 41 (2): 1-16. 

[58] Park C, Moghadam P, Kim S, ef al. Elastic lidar fusion: dense 
map-centric continuous-time SLAM [C]// Proc of IEEE International 
Conference on Robotics and Automation. Piscataway, NJ: IBEE Press, 
2018: 1206-1213. 

[59] Droeschel D, Behnke S. Efficient continuous-time SLAM for 3D 
lidar-based online mapping [C]// Proc of IEEE International Conference 
on Robotics and Automation. Piscataway, NJ: IEEE Press, 2018: 
5000-5007. 


